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基于 Leader-Follower 的 分 队 队 形 控制 寻 径 算法 研究 “ 
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摘 要 : 在 战场 环境 中 ， 战 术 分 队 的 队 形 在 面 对 复 杂 静 态 或 动态 障碍 物 难以 较 好 地 保持 ， 针 对 此 问题 ， 提 出 了 基于 
Leader-Follower 算法 的 改进 队 形 控制 方法 。 在 Leader 寻 径 阶段 ， 通 过 在 战场 导航 网 格 中 应 用 两 阶段 路 径 搜索 方法 ， 先 
使 用 A* 算 法 寻找 由 三 角形 通道 和 可 利用 地 物 组 成 的 路 径 ， 再 使 用 改进 的 Funnel 算法 在 考虑 队 形 规模 的 约束 条 件 下 对 
路 径 作 平滑 处 理 。 在 Follower 跟随 阶段 中 ， 通 过 采用 morphing 技术 ， 产 生 在 复杂 障碍 约束 下 平滑 的 中 间 约 束 队 形 序 
列 ， 并 结合 提出 的 队 形 弹 入 模型 ， 局 部 修正 并 控制 Follower 每 一 时 刻 的 速度 。 为 解决 面 对 动 态 障碍 的 避 碰 问题 ， 基 于 
相对 速度 障碍 法 ， 并 加 入 速度 协同 控制 ， 避 免 队 形 在 避 碰 过 程 中 失效 。 最 后 通过 实验 表明 了 该 方法 的 有 效 性 。 
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Research on team formation control path finding algorithm based on Leader-Follower 
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Abstract: In the battlefield environment, the tactical unit formation is difficult to maintain when facing complex static or 


dynamic obstacles. For this problem, this paper proposed an improved formation control method based on Leader-Follower 


algorithm. In the Leader routing stage, by applying the two-stage path search method in the battlefield navigation mesh, this 


paper used the A * algorithm to find the path composed of the triangular channel and the available objects, and then used the 


improved Funnel algorithm to smooth the path under the constraints of the scale of unit. In the Follower following stage, this 
paper used morphing technique to produce smooth intermediate constraint formation sequences under complex barrier 
constraints and combine the proposed formation spring model to locally correct and control the speed of each follower. In order 
to solve the problem of collision avoidance in the face of dynamic obstacle, this paper used reciprocal velocity obstacle method, 
which joined the speed co-control, to avoid the formation failure in the collision avoidance process. Finally, this paper proved 
the effectiveness of the method by experiments. 
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2 选择 其 中 一 个 agent 作为 队 形 的 Leader， 其 余 的 作为 Follower 

0 引 训 通过 控制 其 与 Leader 的 距离 和 角度 来 形成 队 形 加， 将 复杂 的 
在 作战 仿真 领域 ， 战 术 分 队 的 队 形 控制 是 一 个 重要 问题 ， 队 形 控制 问题 转变 成 Leader 的 寻 径 和 Follower 对 Leader 的 跟 

分 队 在 三 维 战场 环境 中 寻 径 的 同时 ， 还 需要 保持 相应 的 几何 阵 ， 随 问 题 ， 控 制 器 的 设计 相对 简单 并 比较 符合 作战 的 真实 情况 ， 
型 。 目 前 常用 的 队 形 控制 方法 有 基于 行为 法 、 人 工 势 场 法 、 基 ”适合 作为 战术 分 队 队 形 控制 方法 。 
于 图 论 法 以 及 Leader-Follower 法 。 基 于 行为 法 需要 对 agent 行 本 文 基于 Leader-Follower, 在 由 不 规则 三 角 网 (TIN) 组 成 
为 建 模 ， 通 过 感知 当前 环境 选择 前 进 、 避 障 、 维 护 队 形 等 行为 ”的 战场 导航 网 格 中 采用 了 两 阶段 路 径 搜索 方法 ， 首 先 在 代价 函 
趾 , 但 存在 复杂 性 问题 。 人 工 势 场 法 通过 引入 物理 学 的 势 场 , 将 。 ” 数 中 结合 线 状 地 物 的 通行 代价 , 利用 A* 算 法 寻找 由 三 角形 通道 
agent 与 环境 的 约束 由 人 工 势 场 和 势 场 函数 表示 , 通过 势 场 控制 。 和 可 利用 地 物 组 成 的 路 径 ; 然后 使 用 改进 的 Funnel 算法 , 结合 
agent 位 置 站 ， 但 存在 局 部 极 值 点 问题 9。 基 于 图 论 法 用 控制 图 。” 队 形 规模 的 约束 对 路 径 做 平滑 处 理 ， 得 到 平滑 的 移动 序列 ; 
生 述 agent 的 队 形 形 状 , 并 利用 控制 理论 调整 队 形 的 姿态 四, 缺 。 用 morphing 技术 中 ， 生 成 源 队 形 到 目标 队 形 光 滑 的 队 形 变化 ， 
点 是 实现 复杂 ， 一 般 只 用 于 仿真 研究 申 。 而 Leader-Follower 法 ”结合 地 形 障 碍 约束 ， 修 正 并 产生 相应 的 中 间 约 束 队 形 序列 ， 青 
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局 部 修正 并 控制 Follower 每 一 时 刻 
的 速度 ， 同 时 还 加 入 了 反馈 机 制 , 动态 调整 Leader 的 速度 大 小 
以 避免 Follower 掉队 问题 ,， 针 对 行进 过 程 中 动态 障碍 的 避 碰 
问题 ， 在 相对 速度 障碍 法 (RVO) 的 基础 上 ， 加 入 了 速度 协同 
控制 以 保持 队 形 。 最 后 通过 仿真 实验 验证 了 方法 的 有 效 性 。 


1 ”算法 原理 


本 文 提出 的 基于 Leader-Follower 的 改进 队 形 控制 算法 , 在 
整体 上 将 队 形 控制 分 为 两 阶段 : Leader 寻 径 阶 段 和 Follower 跟 
随 阶段 。 

常用 的 路 径 搜 索 算法 有 A* 算 法 、 导 航 网 格 法 、 路 径 点 法 ， 
其 中 A* 算 法 为 图 搜索 算法 , 无 法 直接 应 用 于 三 维 战场 ; 路 径 点 
法 需要 在 场景 中 标定 路 径 点 ， 不 适合 复杂 多 变 的 战场 环境 ， 而 
导航 网 格 法 因 其 贴 合 原 有 场景 空间 ， 并 且 处 理 动态 导航 需求 更 
加 灵活 ， 目 前 被 广泛 应 用 ， 但 导航 网 格 在 跨越 可 穿行 障碍 物 如 
壕沟 时 存在 绕 路 的 现象 . 因此 在 Leader 寻 径 阶段 采用 两 阶段 寻 
径 法 ， 结 合 A* 算 法 和 Funnel 算法 产生 平滑 路 径 。 


使 用 提出 的 队 形 弹簧 模型 ， 


本 文 提出 的 基于 Leader-Follower 的 改进 分 队 队 形 控 制 寻 径 
算法 流程 如 图 1 所 示 。 


构建 导航 网 格 


0 建立 连通 


在 导航 网 格 和 战术 地 形 | ; 
中 使 用 A* 算 法 ， 考 虑 战 


;Leader | 术 动作 代价 
| 寻 径 
; 阶段 0 入 队 形 保持 的 约束 ， 
: Funnel 算 法 对 路 径 
: 平滑 处 理 
用 morphing 技 术 产 生 
间 约 束 队 形 序列 
: Follower : 
; 跟随 队 形 弹簧 控制 和 修正 每 | ; 
: 阶段 一 时 刻 Follower 的 速度 | : 
根据 Follower 跟 随 情 况 
修正 Leader 速 度 大 小 
; 避 辜 
阶段 计算 各 Follower 的 RVO 
设置 Follower 的 统一 避 
倍速 度 


图 1 算法 整体 流程 


2 Leader 寻 径 阶段 


有 天 
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空间 表示 成 由 若干 不 规则 三 角形 组 成 的 网 络 。 导 航 网 格 的 构建 
分 为 五 个 主要 步 又 名， 过 程 如 下 : 

a) 对 三 维 场景 体 素 化 , 将 原始 场景 几何 体 抽象 表示 成 实体 
高 度 场 ; 

b) 生成 导航 区 域 , 通过 检测 实体 高 度 场 的 上 表面 ， 并 将 其 
划分 成 若干 连通 的 区 域 ， 同 时 通过 判断 区 域 是 否 过 于 接近 障碍 
物 以 及 是 否 有 充足 的 空间 来 剔除 无 法 行走 的 区 域 ; 

c) 检测 导航 区 域 的 轮廓 并 将 其 表示 成 多 边 形 , 并 尽 可 能 
外 围 边 平 滑 ; 

d) 将 轮廓 多 边 形 再 分 割 成 凸 多 边 形 ; 

e) 对 凸 多 边 形 Delaunay 三 角 化 并 加 入 高 度 信息 。 

构建 出 的 战场 导航 网 格 如 图 2 所 示 。 


对 


2 战场 导航 网 格 


2.2 两 阶段 路 径 搜索 
在 复杂 的 三 维 场景 中 


， 只 使 用 一 种 路 径 搜索 算法 往往 难以 
使 产生 的 路 径 同时 满足 最 优 和 平滑 ， 特 别 在 战场 环境 中 ， 存 在 
各 种 可 利用 的 地 物 ， 如 轿 坟 m、 掩 体 等 ， 士 兵 会 执行 梦 息 、 翻 越 
等 战术 动作 到 达 目 的 地 。 因 此 ， 提 出 两 阶段 路 径 搜索 法 ， 先 在 
导航 网 格 中 使 用 A* 算 法 ,在 考虑 战术 地 形 库 附加 的 连通 性 和 行 
为 代价 的 基础 上 ， 和 寻找 导航 网 格 中 由 三 角形 通道 和 可 利用 地 物 
组 成 的 路 径 ; 再 使 用 考虑 队 形 约束 的 Funnel 算法 对 三 角形 网 格 
路 径 作 平滑 处 理 。 
2.2.1 A* 路 径 搜索 算法 

A 算法 是 经 典 的 图 路 径 搜 索 算法 ， 根 据 战 场 导 航 网 格 中 三 
角形 的 连通 性 可 以 搜索 起 点 到 终点 的 三 角形 路 径 。 为 使 士兵 在 
寻 径 的 过 程 中 可 以 通过 执行 翻越 动作 ， 利 用 地 物 到 达 目 的 地 ， 
需要 预先 利用 战术 地 形 库 建立 三 角形 与 地 物 的 连通 信息 ， 其 中 
战术 地 形 库存 有 战场 中 线 状 地 物 〈 如 墨 壕 、 撼 体 等 ) 的 位 置信 
息 以 及 执行 战术 动作 穿越 地 物 所 花费 的 时 间 代 价 。 

在 A* 算 法 的 搜索 空间 中 , 除了 考虑 三 角形 间 的 连通 性 , 还 
需 加 入 三 角形 与 可 利用 地 物 的 连通 信息 ,使 A* 搜 索 到 的 路 径 还 


Leader 在 三 维 场景 中 的 寻 径 ， 需 要 先 构建 战场 对 应 的 导航 
网 格 ， 并 在 此 基础 上 应 用 两 阶段 路 径 搜 索 算 法 。 
2.1 构建 导航 网 格 


导航 网 格 ， 作 为 


目前 最 


常用 的 三 维 场景 划分 方法 ， 将 三 维 


包括 地 物 ;同时 为 了 避免 战 术 动 


作 在 局 部 不 必要 的 情况 下 执行 ， 


在 A* 评 估 函 数 中 ， 状 态 n 到 


数 h(n) 中 除了 需要 考虑 距离 估计 ， 


标 状态 最 佳 路 径 的 代价 估计 函 
还 要 考虑 翻越 掀 壕 、 掩 体 等 


线 状 地 物 所 花费 的 额外 花 销 。 假 设 士兵 执行 动作 所 花费 的 时 间 
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为 faction， 七 兵 行 


走时 的 最 大 速率 为 waax， 则 对 应 的 花 销 为 


COSt(2) = fcion * Vinax (1) 
因此 代价 估计 函数 为 
h(n) = dist(n) + B+cost(n) 0O) 
其 中 : < 为 距离 预计 缩放 参数 ，dist(m) 为 节点 n 到 目标 的 欧 氏 


距离 ， 6 为 地 物 开销 预计 缩放 参数 。 
2.2.2 改进 的 Funnel 算法 
经 A 算法 计算 而 得 到 的 是 由 三 角形 通道 和 地 物 组 成 的 路 
径 。 为 了 在 三 维 场景 中 获取 平滑 的 路 径 ， 首 先 需要 计算 路 径 中 
地 物 的 对 应 战术 动作 执行 位 置 ， 然 后 计算 各 三 角形 通道 内 的 最 
短路 径 。 
Funnel 算法 是 在 多 边 形 内 部 寻找 最 短路 径 的 一 种 高 效 算法 ， 
时 间 复 杂 度 为 O(n)， 其 中 代表 多 边 形 三 角 化 后 其 三 角形 的 个 
数 。Funnel 算法 的 思想 是 寻找 多 边 形 中 的 拐角 点 以 形成 自然 的 
漏斗 (图 3 (a) 中 阴影 处 所 示 ),， 在 遍历 


路 径 , 方法 是 通过 设立 ; 
三 角形 的 过 程 中 不 断 缩小 漏斗 的 开口 角度 (图 3 (b) )， 当 漏斗 


ChinaX 具 
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点 数组 


6) 计算 当前 队 形 的 最 大 外 接 圆 半径 为 >， 遍历 拐角 点 
7, 在 以 各 拐角 点 为 圆心 ， 建 立 半径 为 的 圆 ， 计 算 相 邻 圆 的 公 
加 入 最 后 再 将 加 入 R， 如 图 4 所 示 。 

执行 步骤 3)， 直 到 所 有 的 通道 都 经 过 计算 ， 输 出 R 为 
最 终 产生 的 路 径 。 


bn 


| 四 
jy 
癌 ” 酒 


区 约束 的 Funnel 算法 


3 ”Follower 跟随 阶段 


为 使 分 队 在 作战 仿真 过 程 中 保持 队 形 ， 


Leader-Follower 法 


通过 控制 Follower 与 Leader 的 距离 1 和 方位 角 4 形成 不 同 拓 才 


闭合 后 则 意味 着 找到 了 路 径 的 拐角 点 ， 并 重新 设置 漏斗 的 位 置 
(图 3 (c) )， 直 到 寻 径 结束 。 


.Start .Stat Start 


(a) 设 立 漏 斗 


(b) 修 改 漏斗 角度 


(co) 更 新 漏斗 位 置 
图 3 Funnel 算法 计算 拐角 点 过 程 


Funnel 算法 在 计算 拐角 点 时 并 未 考虑 agent 的 大 小 ， 直 接 
应 用 在 分 队 寻 径 上 容易 使 士兵 在 拐角 处 被 卡 住 ， 因 此 需要 在 各 
拐角 处 ,计算 分 队 的 队 形 规 模 ,使 分 队 在 拐弯 时 有 足够 的 空间 。 


对 于 由 A’* 算 法 产生 的 路 径 到， 使 用 满足 队 形 规模 约束 的 
改进 Funnel 算法 产生 最 终 路 径 ， 算 法 描述 如 下 : 


1) 遍历 路 径 所， 寻找 其 中 包含 的 地 物 ， 并 以 地 物 把 到 i 分 
割 成 局 部 三 角形 通道 数组 C， 初 始 化 最 终 路 径 画 。 

2) 对 于 C 中 每 组 相 邻 通道 的 邻近 三 角形 p; 和 pj;， 找 到 pi; 
和 pj 最 接近 的 两 条 边 e; 和 ej, 检测 其 与 中 起 点 和 终点 构成 的 
直线 es 是否 相交 ， 如 果 相 交 则 将 交点 作为 动作 执行 点 ,否则 选 
择 e: 和 ej 与 ex 距离 最 短 的 端点 作为 动作 执行 点 。 

3) 对 于 多 边 形 通道 C, 起 点 为 si, 终点 为 妃 将 si 加 入 RR， 
连接 si 与 s; 所 在 的 多 边 形 临 边 的 左 、 右 端点 n/ 和 nn:， 称 为 左 线 
和 右 线 。 

4) 找到 C; 下 一 个 临 边 的 左 端点 ， 判 断 其 是 否 在 左 线 和 右 
线 组 成 的 区 域内 ， 如 果 在 ， 则 六 更 新 成 此 端点 ;如果 不在 ， 则 
维持 已 不 变 。 同 样 的 方法 对 右 端点 进行 判断 。 

5) 重复 步骤 4), 直到 下 一 个 左 端点 和 右 端点 均 在 左 线 和 右 
线 组 成 的 区 域 之 外 ,停止 循环 , ni (或 n,) 为 拐角 点 ， 并 重复 步 
又 4 和 )， 直 到 找到 所 有 的 拐角 点 并 保存 至 数组 7。 


网 络 结构 外， 而 当 分 队 队 形 需要 在 作战 过 程 中 改变 时 ， 通 常 的 
做 法 是 在 预 设 的 阵型 中 切换 09, 但 这 样 会 使 Leader 与 Follower 
在 单一 阵型 中 的 位 置 相对 固定 ， 难 以 自 适 应 于 战场 地 形 环境 ， 
在 表现 上 不 够 逼真 。 
3.1 队 形 弹簧 模型 

在 现实 生活 中 ， 弹 得 在 遇 到 障碍 物 时 ， 会 呈现 收缩 和 伸 长 
两 种 状态 以 贴 合 障碍 物 ， 而 反映 在 分 队 的 行进 过 程 中 ， 队 形 质 


样 需要 具备 动态 贴 合 战 场 环 境 的 能 力 。 除 此 之 外 ， 弹 筑 受 到 的 
弹力 与 其 变化 的 长 度 成 正比 ,而 当 分 队 成 员 距 离 目 标 位 置 越 远 ， 


则 其 靠近 的 趋势 ， 即 成 员 接近 速度 同样 也 应 该 越 大 。 由 此 可 以 
看 出 ， 分 队 成 员 在 队 形 保持 时 的 移动 与 弹簧 所 反映 出 的 特性 基 
本 一 致 ， 因 此 提出 在 Leader 和 Follower 间 构 建 队 形 弹 得 ， 队 形 
弹簧 会 受 周遭 环境 障碍 物 挤 压 或 在 其 他 外 力 影 响 下 动态 伸缩 ， 
使 Follower 在 尽 可 能 保持 队 形 的 基础 上 ， 动 态 改 变 其 与 Leader 


的 相对 位 置 ， 且 同 时 控制 Follower 的 速度 ， 使 其 尽 可 能 反映 
真实 的 情况 。 
的 -EeE 
、\、 4 Ki 
钨 四 
/ 芝 9 
人 
2 02 
图 5 队 形 弹簧 在 t 时 间 内 收缩 相应 长 度 
如 图 5 所 示 ， 4 表示 由 三 名 成 员 组 成 的 分 队 ， 若 经 过 zt 时 


间 ，47 的 队 形 弹 簧 8S5，? 分 别 受 外 力 影 响 ， 弹 簧 的 长 度 改变 了 
An 和 Aj2， 形 成 新 的 队 形 弹簧 ， 则 当 分 队 中 某 个 Follower 的 队 
形 弹簧 长 度 变化 为 Al 时 ， 根 据 胡 殉 定律 ， 对 应 弹力 Fs 为 
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其 中 : 大 为 队 形 弹簧 的 劲 度 系数 ， 表 示 速 度 


G) 


影响 程度 ， 本 文中 磊 为 常数 ， 取 值 为 (0, 50] 。 
的 加 速度 az 为 


其 中 : m 为 Follower 的 质量 
在 上 时 刻 〈tE[0, 可 ) 的 相对 速率 为 


为 使 Follower 按 对 应 队 形 移动 ， 除 速率 外 ， 
对 应 的 速度 方向 ， 在 z 时刻，Follower ee Si 的 长 
度 为 上 和 与 Leader 运动 方向 的 夹 


形变 长 度 的 
则 Follower 对 应 


(4) 


二， 默认 mm=1， 则 Follower 与 Leader 


(5) 


速度 移动 ， 自 
望 相对 位 置 为 


其 中 : i 为 no 经 Di 旋转 后 的 方向 向 量 
GE[0, 可 ) 的 速度 方向 为 


其 中 : Pi(DO 表 示 上 时 刻 Follower 在 队 

队 形 弹簧 会 实时 根 志 
Follower 掉队 问题 ， 为 解决 这 
则 台 Leader 的 速度 ， 


的 当前 位 置 与 其 


Follower 与 期 望 丰 


意味 着 Follower 与 其 


其 中 ， 7 是 速度 调节 参数 ， 六 E [1, +co)。 
3.2” 队 形 控制 
在 战场 环境 中 ， 分 队 具 有 多 种 战斗 队 形 


期 望 位 置 过 远 ， 则 1 


还 需要 计算 其 


若 Leader 以 ve 尼 
， 则 Follower 与 Leader 的 其 


(6) 


时， 则 Follower 在 t 时 刻 


(7) 


中 与 Leader 的 相对 位 置 。 

景 发 生 改 变 ， 可 能 会 导致 的 
题 ， 引 入 了 反馈 机 制 ， 动 态 
的 稳定 。dmax 表示 Follower 们 
距离 的 最 大 值 ，dnreshod 表示 运行 
I 病 值 。 当 dmax>cdthreshold， 
整 Leader 的 速度 为 


(8) 


队 形 、 梯 


mo 


RSS 


3.2.1 无 障碍 物 约束 的 队 形 变换 控制 

] morphing 渐变 技术 控制 产 
状 光 滑 地 变换 到 目标 形状 ， 
于 Ci 位置 ; 目 
立 置 ， 阵 形变 换 问 题 对 应 于 二 维 多 边 
成 中 间 约 束 队 形 序 


本 文采 | 
Morphing 是 指 将 源 几 何 开 
换 能 量 最 少 。 
形 为 B 阵 形 ， 处 于 
， 使 用 二 维 


渐变 问题 


队 形 、 横 队 队 形 、 纵 队 队 形 


US 


状 morphing 算法 上 入 


SS 


列 , 中 间 约 束 对 形 请 


1) 计算 源 队 形 与 
别 为 S$= {Si|i=0， 
2) 建立 源 队 形 
上 外 5; 向 Dj 变换 所 扫 过 的 面积 a 上 


茜 


En 


点 的 映射 关系 ,其 中 需 寻 


乡 态 有 三 角 
距 为 20~30 


平滑 的 队 形 过 渡 。 


| 越 多 , 变换 过 程 越 光滑 。 算 法 步骤 如 下 : 
.到 中 心 点 的 向 量 序列 , 分 


保持 变 
标 队 


NY 


陈 迄 ， 等 


数 为 Cost(S;, Di)= wiX KGi,)) + waXL(i,)), 


wi+w2 二 1。 面积 


队 汪 4 


Chin 
: 基于 Leader-Follower 的 分 队 队 形 直 算法 研究 


中 0wi, wis 三 1， 


函数 KG, 旋 = 了 43.|x|Di)xsin(b) ， 其 中 0y 


为 5; 与 Dj 的 夹 角 ， 


Sy 


申 缩 量 计算 函数 LG 四 起 5;|-1Dj 上 ， 设 源 队 


形 到 目标 队 形 的 映射 关系 Z:{5,;} 志 {Dj)} ， 则 其 代价 函数 为 


Cost(S,D,2)= S Co Dyn) ， 代 价 函数 的 值 越 小 则 说 明 变 换 效 


果 越 好 ， 使 用 


动态 规划 法 计算 最 佳 映射 匹配 。 
3) 按 预 设 的 时 间 步 长 , 根据 顶点 映射 产生 源 阵 型 到 目标 阵 
型 的 中 间 约 束 队 形 序列 。 


3.2.2 有 障碍 约束 的 队 形 变换 控制 


战场 环境 存 


在 各 种 类 型 的 障碍 物 ， 将 导致 缺 省 的 目标 阵 形 


无 法 在 目标 位 置 被 容纳 的 现象 。 此 时 ， 需 要 对 目标 队 形 形状 进 
心 法 探测 目标 位 置 处 的 最 佳 目 标 阵 形 几 何 


行 修 正 。 本 文采 用 : 


形状 ， 算 法 过 程 


1) 初始 化 旋转 

2) 判断 目标 
没有 ， 则 跳 转 5); 

3) 将 9 增加 3° 


昔 述 如 下 : 
9 度 6 为 0， ee 


多 状 各 顶点 位 置 是 否 与 障 但 物 碰 撞 。 如 果 


否则 继续 执行 3)。 
,对 目标 几何 形状 旋转 6 角 , 如 果 6<360” ， 


则 跳 转 2);， 和 否则 继续 执行 4)。 
4) 将 S 乘 以 缩放 系数 〈 本 文 设 为 0.98)， 对 目标 几何 形状 


缩放 S 倍 ， 跳 转 2)。 


5) 该 目标 几何 形状 即 所 求 的 最 佳 目标 几何 形状 。 


算法 的 实质 是 对 


在 目标 位 置 找到 第 


缺 省 目标 阵 形 反 复 执行 旋转 和 缩放 操作 ， 
个 能 容纳 下 的 经 修正 的 目标 队 形 ， 对 原 队 


形 和 用 修正 后 的 
生 有 障碍 约束 下 站 


SS 


示 队 形 调 用 3.2.1 节 的 morphing 技术 即 可 产 
间 约 束 队 形 序列 。 


值得 注意 的 是 ， 上 述 最 佳 目 标 阵 形 几 人 
E 了 目标 位 置 处 


: 马 | 


状 探测 算法 只 保 


F 形 的 合法 性 ， 中 间 约 束 队 形 序列 仍然 可 能 发 


i Ef 


对 每 一 中 间 约 束 


生 与 障碍 物 冲 突 的 情形 ， 本 文 提 供 两 种 集 略 予以 解决 。 一 种 是 


NN 


同样 调用 上 述 贪 心算 法 检测 出 满足 约束 的 


修正 几何 形状 》 


许 分 队 自动 切换 队 玫 
窄 路 或 复杂 障碍 


压缩 的 现象 。 
3.2.3 队 形 移动 


弹簧 模型 控制 角色 移动 ， 另 一 种 则 多 


当 目 标 几 何 形状 压缩 率 过 大 时 (一般 在 
自动 切换 为 一 字 队 形 , 以 避免 队 形 过 度 


在 中 间 约 束 队 形 上 

动 ，Follower 与 Leader 间 的 队 形 弹簧 则 在 对 应 的 时 间 内 伸缩 至 
的 位 置 ， 并 按 式 (5) 和 (7) 产生 

度 。 同 时 为 避免 Follower 在 移动 过 程 被 障碍 物 卡 住 ， 分 队 需 要 
的 队 形 弹 得 是 否 受 障碍 物 挤 压 ， 如 果 有 则 在 


中 间 约 束 队 形 相应 


一 时 刻 检测 当前 


列 产生 并 修正 后 ，Leader 开始 沿路 径 移 


每 一 时 刻 的 速 


局 部 更 新 Follower 的 速度 方向 以 避 开 障碍 物 。 


4 ”动态 障碍 名 磁 


在 作战 仿真 中 ， 


量 ，5; 到 Dj 对 应 的 代价 函 


维 场景 中 必然 存在 静态 障碍 和 动态 障碍 ， 


而 随 着 队 形 弹簧 和 导航 网 格 的 引入 ， 对 于 静态 障 但 已 经 可 以 产 
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生 避 人 免 碰撞 的 平滑 路 径 ， 并 且 分 队 队 形 可 以 根据 障碍 物 动 态 切 
换 ， 对 于 动态 障碍 采用 考虑 队 形 保持 的 相对 速度 障碍 法 上。 

假设 存在 两 个 agent: A 和 B， 速 度 障碍 OrAle 表示 经 过 
时 间 , A 和 B 发 生 碰 撞 的 相对 速度 集合 , 若 将 agent 以 圆 表示 ， 
则 


D(P,R)={0||0 -P|<R} (9) 


其 中 : P 和 RR 表示 agent 圆 的 圆心 和 半径 ， 则 速度 障碍 为 
YoOWs ={ylmsD(R -RPR +R,)} (10) 


AlB 


其 中 : te[0, 可 ， 则 对 应 的 相对 速度 障碍 RVOrAs 则 为 


RVOWs(VA) = {Va |2v4 — Va eVONs} (11) 


图 6 分 队 队 形 因 动 态 避 碰 而 被 溃散 


合作 期 二 


ChinaXiv 上 
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狭窄 的 通道 相遇 ， 此 时 双方 都 无 法 找到 可 行 的 避 碰 速度 。 因 此 
当 这 类 情况 发 生 时 ， 选 择 冲突 中 的 一 方 原 地 等 待 ， 让 另 一 方 行 
动 ， 当 冲突 解除 后 再 令 等 待 的 分 队 继续 行动 。 


5 ”实验 结果 


本 文 实 现 了 基于 虚幻 引 警 4 的 作战 仿真 系统 ， 并 使 用 了 改 
进 的 分 队 队 形 控制 算法 ， 分 别 对 复杂 障碍 物 环境 下 的 分 队 队 形 
变换 控制 和 分 队 动 态 避 碰 进 行 仿真 实验 ， 能 在 PC 机 (i7- 
7700HQ、16 GB 内 存 、GTX 1060) 上 以 60 帧 每 秒 的 速率 运行 。 


图 8 队 形 变换 效果 


假设 现 有 一 四 人 小 队 ， 初 始 以 三 角 队 形 排列 ， 现 令 其 机 动 
至 目标 位 置 并 变换 至 方 阵 ， 在 复杂 障碍 物 场 景 下 分 队 移动 的 效 
果 如 图 8 所 示 。 当 分 队 移动 至 区 域 A， 通 过 判断 地 形 无 法 容纳 
由 morphing 计算 出 的 中 间 约 束 队 形 ， 分 队 自 动 转换 成 一 字 纵 
队 ， 离 开 区 域 A 后 ， 分 队 在 区 域 B 内 变换 到 方 阵 队 形 并 移动 ， 
遇 到 较 窗 的 区 域 C 时 队 形 压缩 至 合适 位 置 ， 并 最 终 达到 目标 位 


在 一 般 场 景 中 ， 只 需要 找到 不 在 相对 速度 障碍 范围 的 速度 
则 就 可 以 完成 动态 避 磁 ， 但 直接 应 用 于 分 队 的 动态 避 碰 会 因 分 
队 内 各 Follower 的 避 障 方向 选择 不 统一 ,从 而 导致 队 形 被 冲 散 ， 
如 图 6 所 示 。 

为 解决 这 一 问题 ， 在 相对 速度 障碍 法 的 基础 上 加 入 分 队 成 
员 速 度 协同 控制 ,通过 设立 Follower 的 统一 避 碰 速度 yavioa， 对 
分 队 内 的 成 员 分 别 计算 在 + 时 间 内 的 相对 速度 障碍 RVOr， 使 
对 于 附近 的 动态 障碍 ， 都 有 Vavioa 锋 RVO'， 同 时 vewox 要 尽 可 能 
靠近 原本 的 vreade， 尽 量 使 分 队 的 避 碰 幅度 小 。 

避 碰 速度 计算 过 程 如 图 7 所 示 ， 左 边 是 分 队 1 和 分 队 2 相 
遇 时 的 情况 ， 右 边 是 分 队 2 各 成 员 所 对 应 的 相对 速度 障碍 ， 避 
磁 速 度 Vavioa 不 能 位 于 图 中 灰色 虚线 多 边 形 内 , 同时 要 尽 可 能 
近 原 本 的 速度 。 


~ RVOF,p, 2 


图 7 动态 障碍 的 避 碰 方向 选择 


在 某 些 情况 下 ， 发 生 磁 撞 是 不 可 避免 的 ， 比 如 两 个 分 队 在 


置 。 从 图 中 可 以 看 出 ， 由 morphing 产生 的 中 间 约 束 队 形 ， 通 过 
队 形 弹簧 控制 每 一 时 刻 Follower 的 速度 ， 可 以 使 分 队 控制 的 过 
程 光滑 合理 。 

本 文 还 实现 了 其 他 队 形 控制 方法 ， 分 别 为 加 入 切线 避 障 法 
的 Leader-Follower 法 和 基于 人 工 势 场 的 队 形 控制 方法 9, 应 用 
在 图 8 的 场景 中 ， 效 果 如 图 9 所 示 。 从 图 9 (a) 的 方 框 处 可 以 
看 出 ， 人 工 势 场 法 在 分 队 躲 避 障 碍 物 时 会 使 队 形 分 散 ， 而 从 图 
9 'b) 的 方 框 处 可 以 看 出 ， 队 形 因 障碍 物 限制 而 转换 成 了 一 路 
纵队 ， 但 本 文 方法 通过 3.2.2 节 的 修正 算法 缩小 队 形 使 分 队 仍 


(b) 加 入 切线 避 障 法 的 Leader-Follower 法 
图 9 其 他 队 形 控制 方法 


201805.00231v1 


chinaXiv 


录用 稿 


假设 现 有 两 个 分 队 相 遇 , 局 部 避 碰 的 效果 如 图 10 所 示 。 图 


10 (a) 为 两 分 队 刚 开始 相遇 的 情况 ， 从 图 10 (b) 和 (c) 可 以 
看 出 ， 分 队 在 局 部 相遇 避 碰 时 依旧 保持 了 各 自 的 三 角 阵 型 ， 没 
有 被 冲 散 。 


6 


(c)t=2.4s 


(dt=3s 


图 10 分队 相 遇 避 碰 


结束 语 


本 文 提出 了 基于 Leader-Follower 算法 的 改进 队 形 控制 方法 ， 


可 使 分 队 在 战场 环境 面 对 复杂 场景 仍 能 较 好 地 保持 队 形 。 算 法 


将 分 队 控 


制 分 为 Leader 寻 径 阶段 和 Follower 跟随 阶段 。 在 


Leader 寻 径 阶段 中 ， 通 过 A* 算 
虑 队 形 规 


ChinaXi 


| 
陈 ”、 选 ， 等 : 基于 Lodo poo i na yA 期刊、 惠 、 


法 和 改进 的 Funnel 算法 产生 考 
模 约束 的 平滑 路 径 。 在 Follower 跟随 阶段 ， 采 用 


morphing 技术 生成 中 间 约 束 队 形 序列 ， 并 通过 Leader 与 
Follower 之 间 构 建 队 形 弹 得 ,局 部 控制 和 修正 每 一 时 刻 Follower 


的 速度 ; 同时 加 入 反馈 机 制 动 态 修正 


Leader 的 速度 以 避免 


Follower 产生 掉队 ， 并 基于 相对 速度 障碍 法 及 速度 协同 控制 算 


法 保证 了 队 形 在 避 碰 


过 程 的 一 致 性 。 最 后 通过 仿真 实验 验证 了 


算法 可 行 性 。 
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